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INTERNATIONAL PRE 



EXAMINATION REPORT 



Intf 
PCT 



^al application No. 
00/00034 



I. Basis of the report 



1. With regard to ±e elements of the international application:* 
the international application as originally filed 

I I the description: 

pages 

pages 

pages 



, as originally filed 
, filed with the demand 



, filed with the letter of 



I ] the claims: 

pages 

pages 



, as originally filed 

, as amended (together with any statement) under article 19 

, filed with the demand 



pages 



, filed with the letter of 



I I the drawings: 

pages 

pages 



, as originally filed 
, filed with the demand 



, filed with the letter of 



I I the sequence listing part of the description: 

pages 

pages 

pages 



, as originally filed 
, filed with the demand 



, filed with the letter of 



2. With regard to the language, all the elements marked above were available or furnished to this Authority in the language m which 
' the international ^plication was filed, unless otherwise indicated under this item. . 

These elements were available or fiimished to this Authority in the following language wmcn is. 

I I the language of a translation furnished for the purposes of international search (under Rule 23. 1(b)). 
I I the language of publication of the international application (under Rule 48.3(b)). 

I — I the language of the translation fiimished for the purposes of international preUminary examination (under Rules 55.2 and/ 
' — ' or 55.3). 

3. With regard to any nucleotide and/or amino acid sequence disclosed in the international Explication, the international 
' preliminary examination was carried out on the basis of the sequence listing: 

I I contained in the intemational application m written form. 

j [ filed together with the intemational application in computer readable form. 

I [ furnished subsequently to this Authority in written form. 

I I furnished subsequently to this Authority in computer readable form. 

I — I The statement that the subsequently fiimished written sequence listing does not go beyond the disclosure in the 

' — ' intemational aoolication as filed has been fiimished . . , . , , v,„o 

1—1 TlillSentthat the information recorded in computer readable form is identical to the written sequence hstmg has 

1 — I been fiimished. 
4. 1 I The amendments have resulted in the cancellation of: 

I I the description, pages ' 

I I the claims, Nos. 

I I the drawings, sheet/fig 

□ This report has been established as if (some of) the amendments had not been made, since they have been considered to gp 
beyond the disclosure as filed, as indicated in the Supplemental Box (Rule 70.2 (c)).** 

» Replacement sheets which have been Jurnished to the receiving Office in response to an imitation under j^^f^^^f^^ referred to 
in this report as ^'originally filed" and are annexed to this report since they do not contain amendments (Rules 70. JO 
and 70. 1 7), 

** Any replacement sheet containing such amendments must be referred to under item I and annexed to this report. 
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V. Reasoned statement under Artide 35(2) with regard to novelty, inventive step or industrial applicability; 
citations and explanations supporting such statement 



1. Statement 



Novelty (N) Claims 1-24 

Claims 



Inventive step pS) Claims 1-24 



YES 

" NO 

^ YES 

Claims , , 



Industrial applicability (lA) Claims 1-24 

Claims 



YES 
NO 



2. Citations and explanations (Rule 70.7) 

The claimed invention relates to a method and an arrangement 
for synthetically calculating redundant attitude for an 
aircraft when the heading of the aircraft is known. The 
claimed invention also relates to a method for synthetically 
calculating redundant attitude and redundant heading for an 
aircraft with the aid of data existing in the aircraft. When 
the heading is available, attitude is calculated on the basis 
of the aircraft-fixed angular rates and the calculated 
attitude is corrected by means of air data and heading. 

When the heading is not available attitude and heading are 
calculated on the basis of the body-frame angular rates and 
errors in the measured body-frame magnetic field vector 
components are estimated. The measured body-frame field 
magnetic field vector is derived. Errors in calculated 
attitude and heading are estimated with the aid of air data 
and derived measured body- frame magnetic field vector 
components. The calculated attitude and heading are corrected 
by means of estimated errors in attitude and heading. 

Documents cited in the International Search Report: 

US 4914598 
US 5841537 
WO 9726553 

None of the documents describe a method and an arrangement for 
synthetically calculating redundant attitude and redundant 
heading by means of data existing in an aircraft as specified 
in the claims. 

The claimed invention is considered to fulfil the requirements 
of novelty (N) , inventive step (IS) and industrial 
applicability (lA) . 
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The undersigned requests that the present 
international application be processed 
according to the Patent Cooperation Treaty. 



rRECORP COPY i m 
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iving Office use only « 

PCT/SE 00/ 0 0034 



Internationa! Application No. 



International Filing Date 



t 2 -01- 2000 



,09/809: ?! 



The Swedish Patent Office 
POT International Application 

Name of receiving Office and "PCT International Application" 



] 



Applicant's or agent's file reference 
(if desired) (12 characters maximum} 



V' «Q7 PPT 



Box No. I TITLE OF INVENTION 

AUXILIARY SYSTEM IN AN AIRCRAFT FOR INDICATING ATTITUDE 
AND HEADTNR 


Box No. II APPLICANT 


Name and address: (Family name followed by given name; for a legal entity, fidl official 
designation. The address must include postal code and name of country. The country of the 
adi^ess indicated in this Box is the applicant *s State (that is, country) of residence if no State 
of residence is indicated below,) 

SAAB AB 

SE-581 88 LINKOPING 
SWEDEN 


[ j This person is also inventor. 


Telephone No. 

013-18 00 00 


Facsimile No. 

013-18 71 95 


Teleprinter No. 


State (that is, country) of nationality: 
Sweden 


State (that is, country) of residence: 
Sweden 


This person is applicant | — 1 all designated | 1 all desijgnated States except 1 — | the United States | 1 the States indicated in 

for the purposes of: /States 1 ^1 the United States of America | | of America only | | the Supplemental Box 


Box No. Ill FURTHER APPLICANT(S) AND/OR (FURTHER) INVENTOR(S) 


Name and address: (Family name followed by given name; for a legal entity, full official 
designation. The address must include postal code and name of country. The country of the 
address indicated in this Box is the applicant s State (that is, country) of residence if no State 
of residence is indicated below.) 

Adebjork, Peter 
Gr yningsga tan 73 
SE-589 29 LINKOPING 
Sweden 


This person is: 

[ 1 applicant only 

I y 1 applicant and inventor 

1 1 inventor only (If this check-bax 
' — ■ is marked, do not fill in below.) 


State (that is, country) of nationality: 
Sweden 


State (thd{ is, cotmtry) of residence: 
Sweden 


This person is applicant 1 1 all designated 1 1 all designated States except | | the United States 1 | the States indicated in 

for the purposes of: 1 1 States I I the United Stales of America 1 XI of America only 1 1 the Supplemental Box 


Further applicants and/or (further) inventors are indicated on a continuation sheet. 


BoxNo. rV AGENT OR COMMON REPRESENTATIVE; OR ADDRESS FOR CORRESPONDENCE 


The person identified below io hirwby/has been appointed to act on behalf [— j ^ j 1 common representative 
of the applicant(s) before the competent International Authorities as: 1 — 1 


Name and address: (Family name followed by given name; for a legal entity, full official 
designation. The address must include postal code and name of country.) 

Lundmark, Jan-Erik 
SAAB AB 

Patent Department 
SE-581 88 LINKOPING 
Sweden 


Telephone No. 

013-18 71 97 


Facsimile No. 

013-18 71 95 


Teleprinter No. • 


1 — 1 Address for correspondence: Mark this check-box where no agent or common representative is/has been appointed and the 
1 1 space above is used instead to indicate a special address to which correspondence should be sent 
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Continuation of Box No. Ill FURTHER APPUCANT(S) AND/OR (FURTHER) INVENTOR(S) 



If none of the fotlowing sub-boxes is used, this sheet should not be included in the request 


Name and address: (Family name followed by given name: for a legal entity, full official 
designation. The address must include postal code and name of country. The country of the 
add^ss indicated in this Box is the applicant s State (that is, country) of residence if no State 
of residence is indicated below.) 

Nordlund , Per-Johan 
Vretagatan 17 
SE-582 37 LINKOPING 
Sweden 


This person is: 

1 1 applicant only 

1^ 1 applicant and inventor 

1 1 inventor only (If this check-box 
is marked, do not fill in below.) 


State (that is, country) of nationality: 


State (that is, country) of residence: :_. -r. : 


This person is applicant l 1 all designated 1 1 all designated States except l^^the United States r~\ the States indicated in 

for the purposes of: t 1 States 1 1 the United States of America Jij of America only | | the Supplemental Box 


Name and address: (Family name followed by given name: for a legal entity, fidi official 
designation The address must include postal code and name of country. The country of the 
add^ss indicated in this Box is the applicant s State (that is, country) of residence if no State 
of residence is indicated below.) 

Carlsson, Carl-Olof 
Skogsly ckegatan 11 D 
SE-587 27 LINKOPING 
Sweden 


This person is: 

I 1 applicant only 

[x 1 applicant and inventor 

1 1 inventor only (If this check-box 
^ is marked, do not fill in below.) 


State (that is, country) of nationality: 


State (that is. country) of residence: 


This person is applicant i 1 all designated j 1 all designated States except the United States | 1 the States indicated in 

for the purposes of: 1 1 States | | the United States of America J^SL of America only 1 1 the Supplemental Box 


Name and address: (Family name followed by given name: for a legal entity, full official 
designation. The address must include postal code and name of country. The country of the 
address indicated in this Box is the applicant s State (that is, country) of residence if no State 
of residence is indicated below.) 


This person is: 

1 1 applicant only 

1 1 applicant and inventor 

1 1 inventor only (If this check-box 
* ' is marked, do not fill in below.) 


State (that is. country) of nationality: 


State (that is. country) of residence: 


This person is applicant l j all designated j 1 all designated States except 1 1 the United States i 1 the States indicated in 

for the purposes of: 1 1 States 1 1 the United States of America 1 1 of America only | | the Supplemental Box 


Name and address: (Family name followed by given name: for a legal entity, full official 
designation. The address must include postal code and name of country. The country of the 
address indicated in this Box is the applicant '5 State (that is, country) of residence if no State 
of residence is indicated below.) 


This person is: 

1 1 applicant only 

1 1 applicant and inventor 

1 1 inventor only (If this check-box 
is marked, do not fill in below.) 


State (that is, country) of nationality: 


State (that is. country) of residence: 


This person is applicant I 1 all designated | — 1 all designated States except | — | the United States | j the States indicated in 

for the purposes of: 1 1 States | | the United States of America | | of Amenca only | | the Supplemental Box 


1 1 Further applicants and/or (further) inventors are indicated on another continuation sheet 
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The. following designations are hereby, made under Rule 4.9(a) (mark the applicable check-boxes: at least one must be marked): 
Regional Patent 

D AP ARIPO Patent: GH Ghana, GM Gambia, KE Kenya, LS Lesotho, MW Malawi, SD Sudan, SLSien^ Leone, SZ Swaziland, 
UG Uganda, ZW Zimbabwe, and any other State which is a Contracting State of the Harare Protocol and of the PCT 

□ EA Eurasian Patent: AM Armenia, AZ Azerbaijan, BV Belarus, KG Kyrgyzstan, KZ Kazakhstan, MD Republic of 

Moldova, RU Russian Federation, TJ Tajikistan, TM Turkmenistan, and any other State which is a Contracting State 
.of the Eurasian Patent Convention and of the PCT 

G3 EP European Patent: AT Austria, BE Belgium, CH and LI Switzerland and Liechtenstein, CY Cyprus, DE Germany, 
DK Denmark, ES Spain, FI. Finland, FR France, GB United Kingdom, GR Greece, IE Ireland, IT Italy, LU Luxembourg, 
MC Monaco, NL Netherlands, PT Portugal, SE Sweden, and any other State which is a Contracting State of the European 
Patent Convention and of tfie PCT 

□ OA OAPI Patent: BF Burkina Faso, BJ Benin, CF Central African Republic, CG Congo, CI Cdte d'lvoire, CM Cameroon, 

GA Gabon, GN Guinea, GW Guinea-Bissau, ML Mali, MR Mauritania, NE Niger. SN Senegal, TD Chad, TG Togo, and 
any other State which is a member State of OAPI and a Contracting State of the PCT ^ other kind of protection or treatment 

desired, spec^ on dotted Ime) 

^9^&oxisAVzteat(ifotherkirtdofpr<^ctionortreamer^ 
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AU 
AZ 
BA 
BB 
BG 
BR 
BY 
CA 



CU 

CZ 

DE 

DK 

EE 

ES 

FI 

GB 

GD 

GE 

GH 



HU 

ID 

IL 

IN 

IS 

JP 

KE 

KG 

KP 



AE United Arab Emirates 

AL Albania 

AM Armenia - .. 

AT Austria 

Australia 

Azerbaijan 

Bosnia and Herzegovina 

Barbados 

Bulgaria . . . ; 

Brazil . 

Belarus 

Canada 

CH and LI Switzeriand and Liechtenstein 

CN China . 

Cuba 

Czech Republic 

Germany 

Denmark 

Estonia 

Spain . 

Finland 

United Kingdom 
Grenada 

Georgia 

Ghana 

GM Gambia 

HR Croatia 

Hungary 

Indonesia 

Israel 

India 

Iceland 

Japan 

Kenya 

Kyrgyzstan 

Democratic People's Republic of Korea 



KR 
KZ 
LC 
LK 



Republic of Korea 

Kazakhstan 

Saint Lucia 
Sri Lanka 
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Check-boxes reserved for designating States which have 
become party to the PCT after issuance of this sheet: 

□ ■ 

□ ^^^^^^ 



LR Liberia 

LS Lesotho . 

LT Lithuania 
LU Luxembourg 

LVL Latvia _ . , „ _ „ _ . . 

MD Republic of Moldova 

MG Madagascar — .... 

MK The former Yugoslav Republic of Macedonia 

MN Mongolia 

MW Malawi 

MX Mexico . , 

NO Norway 

NZ New Zealand 

PL Poland 

PT Portugal 

RO Romania 

RU Russian Federation 

SD Sudan 

SE Sweden 

SG Singapore 

SI Slovenia 

SK Slovakia 

SL Sierra Leone 

TJ Tajikistan 

TM Turkmenistan 

TR Turkey : 

TT Trinidad and Tobago 

UA Ukraine 

UG Uganda 

US United States of America 



UZ 
VN 
YU 
ZA 
ZW 



Uzbekistan . . 
Viet Nam . . . 
Yugoslavia . . 
South Africa . 
Zimbabwe . . 



Precautionary Designation Statement: In addition to the designations made above, the applicant als;o makes under Rule 4.9(b) all other 
designations which would be permitted under the PCT except any designation{s) indicated in the Supplemental Box as being excluded 
from the scope of this statement. The applicant declares that those additional designations are subject to confirmation and that any 
designation which is not confirmed before the expiration of 1 5 months from the priority date is to be regarded as withdrawn by the applicant 
at tiie expiration of that time limit (Cor^rmation of a designation consists of the filing of a notice specifying that designation and the payment of 
the cksignation and confirmation fees. Confirmation mitst reach the receiving Office within the IS-month time limit:) - 
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Box No. VI PRIORITY CLAI 



Sheet No. 



1 3 -Ot - 2000 



rn Further pnonty claflWre indicated in the Supplemental Box. 



Filing date 
of earlier application 
(day/month/year) 


Number 
of earlier application 


Where earlier application is: 


national application: 
country 


regional application:* 
regional OfRce 


international application: 
receiving Office 


itcm(l) 18 Jan -99 
18.1 1999 


9900113-3 


Sweden 


- -.- - . - 




item (2) 










item (3) 











Q 



The receiving OflFice is requested to prepare and transmit to the International Bureau a certified copy 
of the earlier appIication{s) foniy if the earlier application was filed with the Office which for the 
purposes of the present international application is the receiving Office) identified above as item(s): 



(1) 



♦ Where the earlier application is an ARIPO application, it is mandatory to indicate in the Sttpplemental Box at let^t one country pony to the Paris 
Convention for the Protection of Industrial Property for which that earlier application was filed (Rule 4. 10 (b)(ii)), See Supplemental Box. 



Box No. VII INTERNATIONAL SEARCHING AUTHORITY 



Choice of International Searching Authority (ISA) 

(if two or more international Searching Authorities are 
competent to carry out the international search indicate 
the Authority chosen; the two-letter code may be used) : 

ISA/ SE 



Request to use results of earlier search; reference to that search (if an earlier 
search has been carried out by or requested from the International Searching Authority): 



Number Country (or regional Office) 

SE 99/00081 SE 



Box No. VIII CHECK LIST; LANGUAGE OF FILING 



This international application contains 
the following number of sheets: 



request 

description (excluding 
sequence listing part) 

claims 

abstract 

drawings 

sequence listing part 
of description 

Total number of sheets 



- 4 
•J20 

1 
3 

32 



7 



This international application is accompanied by the item(s) marked below: 

1. □ fee calculation sheet / 

2. separate signed power of attorney 

3. □ copy of general power of attorney; reference number, if any: 

4. □ statement explaining lack of signature 

5. □ priority document(s) identified in Box No. VI as item(s): 
6- □ translation of international application into (language): 

7. □ separate indications concerning deposited microorganism or other biological material 

8. □ nucleotide and/or amino acid sequence listing in computer readable form 

9. □ other (specify): ^ 



Figure of the drawings which 

should accompany the abstract: p ^ 



Language of filing of the 
international application: 



Swedish 



Box No. IX SIGNATURE OF APPLICANT OR AGENT 



Next to each signature, indicate the name of the person signing and the capacity in which the person signs (if such capacity is not obviomfrom reading the request). 

LinkoDi>6^. Jarmarv lU. ^00 






1, Date of actual receipt of the purported 1 2 "01* 2000 
international application: 


2. Drawings: 
1^^^ received: 

1 1 not received: 


3. Corrected date of actual receipt due to later but 
timely received papers or drawings completing 
the purported international application: 


4. Date of timely receipt of the required 
corrections under PCT Article 1 1(2): 


5. International Searching Authority to a / ^< 
(if two or more are competent): Voix i St^ 


6. 1 — 1 Transmittal of search copy delayed 
LJ until search fee is paid. 



For International Bureau use only 



Date of receipt of the record copy 
by the International Bureau: 



1 5 FEBRUARY 2000 



( 15.0^00) 

See Notes to the request form 
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Reservsystem for angivande av kurs och attityd i ett flygplan 
TEKNISKT OMRAdE 

Uppfinningen avser en systemfunktion som ger presentation av kurs och flyglage (attityd) pi 
indikatorer i flygplan, t.ex. en siktlinjesindikator (SI), vid fel pk viss utrustning for ordinarie 
flyglagespresentation. Systemfunktionen, som pk engelska benamns Attitude and Heading 
Reference System och forkortas AHRS efter initialema, kompletterar flygplanets ordinarie 
presentation for kurs och flyglage. Denna presentation ska hjalpa piloten att ta sig ur svSra 
flyglagen och sedan underlatta hemflygning/landning. 

TEKNIKENS STANDPUNKT 

For att inte tappa attityd- och kurspresentation i ett flygplan vid bortfall av ett ordinarie anvant 
troghetsnavigeringssystem (TNS) kravs ett reservsystem. Vid god sikt kan en pilot flyga 
genom att anvanda horisonten som attitydreferens, dock med stor osakerhet om kursen. I 
dSligt vader, i moln och nattetid nar horisonten ej ar synlig kan piloten snabbt bli desorienterad 
och darvid fbrsatta flygplanet och sig sjalv i farliga situationer. 

AHRS-system beraknar, oberoende av ordinarie system, attitydvinklar (tipp och roll) och 
flygriktning (kursen). Ett sidant system presenterar kontinuerligt laget for piloten pi en 
indikator i kabin. Behovet av ett reservsystem for attityd kan vara s& stort att flygplan utan ett 
fiingerande sidant inte tillits att flyga. 

Reservsystem i form av en AHRS apparat finns tillganglig idag. En s&dan innehiller bl a gyron 
som mater lagesf orandringar i tipp-, roll- och girled for flygplanet. Den innehiller vidare 
accelerometrar och magnetiska sensorer. Accelerometrama anvands for att etablera ett 
horisontalplan. Magnetsensorema anvands for att istadkomma en magnetisk nordande. Denna 
typ av AHRS-system i apparatform ar dyrbara enheter och medfor installation av vikt- och 
utrymmeskravande utrustning i flygplanet For att rida bot pi detta foreslis i denna 
beskrivning en syntetisk AHRS som anvander i flygplanet befintliga givare, vilka nomialt inte 
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ar avsedda for AHRS-berakningar och darmed delvis med vasentligt samre prestanda, istallet 
for givare av den typ som ingSr i en AHRS-apparat. 

Vinklama beraknas med hjalp av i flygplanet befintliga givare. S)rftet ar att anvanda befintliga 
vinkelhastighetsgyrosignaler och stotta dessa med berakningar utgSende frSn andra 
tillgangliga primardata i flygplanet, \^nkelhastighetsgyron anvands normalt i styrsystem och 
har i allmanhet vasentligt storre drift an gyron for navigering. 



BESKRIVNING AV UPPFINNINGEN 

Enligt en aspekt av uppfinningen tillhandahSlls en metod for att syntetiskt berakna 
reservattityd och reservkurs medelst i ett flygplan befintliga data sSsom specificerat i 
patentkraven. 

Olika utforandeformer har utvecklats. Vid ett utforande finns flygplanets kurs tillganglig och 
vid ett annat utforande beraknas kursen utifrSn en magnetisk kursgivare. Nar kursen finns 
tillganglig kan berakningama reduceras vasentligt. 

Da kursen ar tillganglig (reservkurs) sker berakningen av attityd genom sammanvagning av 
signalema frSn vinkelhastighetsgyrona i flygplanets styrsystem, information frSn luftdata 
(hojd, fart, anfallsvinkel) samt information om kurs (reservkurs). 

Di kursen inte ar tillganglig sker berakningen av attityd och kurs enligt ett utforande med 
hjalp av kalmanfilter genom sammanvagning av signalema fr&n vinkelhastighetsgyrona i 
flygplanets styrsystem, information frSn luftdata (hojd, fart, anfallsvinkel och 
snedanblisningsvinkel) samt information frSn en i flygplanet befintlig magnetkursdetektor. 



En fordel med en syntetisk AHRS enligt uppfinningsaspekten ar att den staller sig vasentligt 
billigare an konventionella p& egna givare baserade AHRS-system om befintliga givare i 
flygplanet kan anvandas. Di frigors utrymme och vikt i flygplanet. 



FIGURBESKRTVNING 
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Figur 1 visar en schematisk bild over en AHRS-fiinktion, dar kursen ar tillganglig. 

Figur 2 visar piincipen for invridning av laget for flygplanet i en siktlinjesindikator, till vanster 
utan invridning och till hoger med invridning. 

Figur 3 visar blockschemat for ett reservsystem for bSde attityd och kurs- 

Figur 4 visar i tre bilder fly gplanets attityd och kurs samt axlama i det skrovf asta 
koodinatsystemet (body frame) samt anfallsvinkel och snedanbl&sningsvinkeL 

Figur 5 visar hur noUfel och skalfaktorfel slSr igenom pi uppmatt varde. 
BESKRIVNING AV UTFORINGSFORMER 

Ett antal utforanden beskrivs i det foljande med stod av figurema. Enligt uppfinningen 
tillhandahSlls metoder for att syntetiskt berakna attityd och kurs medelst i flygplanet befintliga 
data sisom specificerat i patentkraven. 

Vid ett enklare utforande finns flygplanets kurs tillganglig. Vid ett annat utforande beraknas 
kursen, i detta fall utifrin en magnetisk kursgivare. 

AHRS-berakning nar kursen ar kand 

For att bestamma flygplanets orientering reiativt referenskoordinatsystemet N (navigation 
frame) anvands signalema fir&n de tre skrovfast monterade vinkelhastighetsgyrona 2. 
Vinkelhastighetsgyrona 2 mater vinkelhastigheter omkring de tre kroppsfasta 
koordinataxlama (x, y, z). Vinkelhastighetema brukar normalt ha beteckningen CDx eller p 
(rotation kring x-axeln), cOy eller q (rotation kring y-axeln) och eller r (rotation kring z- 
axeln). Orienteringen mellan det skrovfasta koordinatsystemet B (body) och N-systemet ges 
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av eulervinklama 6, <|) och \|/. Eftersom kursen ar kand ar dock bara G och ^ av iixtresse. Med 
antagandet att N-systemet ar ett inertialsystem och orienterat si att dess z-axel ar parallell med 
jordens g-vektor kan man visa att • 



e 









a)yCos(|> - (D^suKj) 
00- + tan0(a) sin(j) + co cos4>) 



(1) 



Om gyrona 2 vore ideala, begynnelsevardena och Qq felfiia och om integrationsmetoden 
som anvands vore exakt kan attitydvinklar erhSllas genom att ekv (1) loses. I praktiken ar dock 
inga av dessa forutsattningar uppfyllda, utan sensorfel m.m. gor att losningen divergerar och 
relativt snart blir oanvandbar. 

Sensorfel i form av bl a nollfel, skalfaktorfel, snedmontering och accelerationsinducerade 
drifter utgor de dominerande felkalloma. I planflykt ar nollfelet den felkalla som dominerar 
feltillvaxten. 

P4 grund av sensorofullkomligheter och osakerhet i begynnelsevarden ger ekvation (1) en 
skattning av roll- och tippvinkelderivator enligt 



<P = 







CD 


II 




{ 



CO cos cousin $ 



(2) 



Skillnaden mellan forvantade ^ahrs (av AHRS-funktionen beraknade) och "verkliga" (p^f 
(av luftdata, primardata beraknade) attitydvinklar utgor en skattning av attitydfelet 



Acp = ipAHRS - <Pref 

Se nedan avseende anvandning av Acp. 



(3) 



Attitydvinklama ges slutligen som 




<PAHRS 



\dt + (pQ-lim{A(p) 
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(4) 



dar <po utgor skattade begjoinelsevarden. 



Berakning av cp,^f 

berakning av Q^f anvands formeln G^f = arcsin ih/y{) + (a * cos <|)). ^ ar en 
hogpassfiltrerad hojdsignal. Sr trae airspeed. 
Vid berakning av anvands formeln ^^^f = arctan (v^ * ( v)/g). 
Y ar en hogpassfiltrerad kurs(reservkurs)-signal. 

Nollkorrigering av vinkelhastighetsgyron 



Nollfelen i vinkelhastighetsgyrona 2 ar starkt temperaturberoende. Det kan ta 20-30 minuter 
for gyrona att uppn& driftstemperatur. Detta medfor att ett TNS-fel kort efter start skulle kunna 
ge stora noUfel vid fortsatt flygning. Det tar dock en viss tid frSn det att gyrona 2 erh&ller 
spanning till dess att flygplanet lattar, vilket innebar att en del av temperaturinsvangningen ar 
genonrford nar ett flygpass inleds. Dessutom forutsatts att landning kan ske inom kort tid vid 
TNS-fel under start. For att minimera nollfel frin vinkelhastighetsgyrona 2 utfors en 
nollkorrigering av vinkelhastighetsgyrona med programvara. Detta gSr ut pk att O) (p, q och r) 
- signalema frSn vinkelhastighetsgyrona 2 jamfors med motsvarande signaler friui TNS, se ekv 
(5), genom en skillnadsbildning i 4a. Skillnaden ligpassfiltreras i ett filter 5 och laggs till 
vinkelhastighetsgyrosignalema i en skillnadsbildare 4b, varvid signalen (O^ som betecknar de 
noUfelskorrigerade gyrosignalema erhSlls och anvands istallet for a> i AHRS-berakningama. 
Detta sker kontinuerligt sk iMnge TNS fungerar. Vid ett TNS-fel utnyttjas de sist utforda 
nollkorrigeringama for resten av flygningen. 
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G>TNS = 



Pr^5 4^rAr5 — Vw5 sin Brivy" 

^TNs ~ 6r//5COS(|>r;v5 + \ifrAr5COs6r^5sin<j)7-A^j 

/rjvsj [-erAr5sin(t>7.jv5 + V7w5COservv5COS<|)w5 



(5) 



Ett blockschema over realiseringen av AHRS-funktionen med nollkorrigering av 



vinkelhastighetsgyrona &terges i figur 1. Figuren ger en schematisk bild av AHRS-funktionen. 
Nollkorrigeringen av vinkelhastighetsgyrona utfors av enhetema innanfor det streckade 
omr&det D. 



anvands i ekv (5), vilken ger (Ojns ( Ptns» Qtns- ^tms) ^ forsta block 1. co ( p, q, r) som 
erhills som signaler frSn gyrona betcknade med 2 i ett andra block l&gpassfiltreras i ett 
l&gpassfilter 3 innan skillnadsbildningen sker i 4a. 

Skillnadssignalen mellan a>iTsjs ( Ptns* Qtms* rTNs)-signalema och co ( p, q, r)-signalema 
ligpassfiltreras med ISng tidskonstant i ett ligpassfilter 5, dvs. medelvardesbildas under l&ng 
tid. Filtret 5 initialsatts vid startrotation med en kortare tidskonstant. Efter ett kraftavbrott 
initialsatts filtret 5 momentant 

I blocket 7 beraknas cp, varefter integrationen enligt ekvation (4) utfors i en integrator 8, till 
vilken begynnelsevillkoren cpo fors. I en skillnadsbildare 9a tillfors signalen Acp som dock 
kopplas bort medelst en brytare 9b under vissa omkopplingsvillkor, som t ex nar I7I > 
samt |())| > (t>LiM- Acp-signalen passerar en begransare 9c. Storleken p& utsignalen fran 
begransaren 9c ar beroende av storleken p& A(p-signalen (dvs insignalen till begransare 9c). 
A^signalen bildas enligt ekv (3) i en skillnadsbildare 9d till villken fors beraknade (pAHRS - 
attitydvinklar och "verkliga" cpj^f -attitydvinklar frSn givare (primardata) betecknade med 9e. 



Vtns> ®TNS ^Hns hogpassfiltreras for att erhSlla ^tns * ^TNS ^tns- Dessa 



De framraknade vinklama frSn AHRS inneh&ller trots kompenseringar sm& nollfel. Di 
utsignalema anvands for presentation i SI korrigeras detta genom anvandning av A<|) i rolled 
och A6 i tippled for att vrida in SI bilden tills ett stabilt lage erh&llits. Se figur 2, dar linjen H 
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symboliserar verklig horisont och dar ett flygplan lepresenteras av P. Observera att denna 
invridning av Sl-bilden endast sker di man ligger innanfor ovan redovisade granser. 

AHRS-berakning nar aven kursen ska beraknas 

Figur 3 ask&dliggor schematiskt de moduler som utgor byggblock for en andra variant av en 
syntetisk AHRS och bur dessa moduler ar sammanlankade for att skapa en reservattityd och 
en reservkurs. 

Figur 3 Ssk^iggor principen for reservsystemet enligt uppfinningsaspekten. Systemet bestSr 
av tv& delsystem A och B; det forsta delsystemet A utfor skattning av eventuella fel i uppmatt 
jordmagnetiskt fait och det andra delsystemtet B utfor berakning av reservattityd och kurs. 
Totalt leder detta till fern byggblock, dar en forsta matrutin 10 och ett forsta kalmanfilter 1 1 
utgor byggblocken i det forsta delsystemet A och vidare dar integrationsrutinen (1/s) 20, 
matrutin 2 1 och ett andra kalmanfilter 22 utgor byggblocken i det andra delsystemet B. 
Med matrutin 10 transformeras uppm^tta faltvektorkomponenter i det skrovfasta 
koordinatsystemet, kallat body frame, till ett nordligt, ostligt och vertikalt orienterat 
koordinatsystem, kallat navigation frame. Transformationen sker med hjalp av attityd och kurs 
frSn flygplanets troghetsnavigeringssystem, TNS, via ledning 12. De jordmagnetiska 
faltvektorkomponentema, hamtas frSn en i flygplanet befintlig magnetkursgivare och 
inkonmier via ledning 13. I det forsta kalmanfiltret 1 1 skattas sedan felen i 
faltvektorkomponentema utifr&n information om hur komponentema nominellt ska vara 
beskaffade, varefter de skattade vardena lagras i ett nwnne 14. 

Delsystem A (matrutin 10 och kalmanfilter 1 1) anvands bara dk TNS fungerar felfritt. Vid 
eventuellt bortfall av TNS anvands senast mojliga skattning av felen i 
faltvektorkomponentema, dvs det som finns undanlagrat i minnet 14. Eftersom det i mSnga 
fall kan vara svSrt att avgora om TNS fungerar som det ska, bor inte den absolut senaste 
skattningen utnyttjas. For att losa detta ar de skattningar av fel i uppmatt jordmagnetiskt fait 
som anvands minst ett flygpass gammalt, dvs de skattningar som finns lagrade i minnet ar frSn 
foregdende flygpass eller tidigare. 
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Integrationsrutinen 20 fSr information om vmkelhastigheter, i det bar fallet for de tre 
koordinataxlama x, y ocb z i body frame. Dessa bnikar normalt ba beteckningen (Oj^ eller p 

(rotation kring x-axeln), eller q (rotation kring y-axeln) ocb co^ eller r (rotation 

kring z-axeln). Informationen hamtas frSn styrsystemets vinkelbastigbetsgyron ocb matas via 
ledningen 15 till rutinen 20 som integrerar fram attityd ocb kurs via en transformationsmatris. 

Den andra matrutinen 2 1 bestSr av en utvecklad variant av den f Orsta matrutinen 1 1 ocb 
anvander de frSn den forsta matrutinen 1 1 erb&llna devierade faltvektorkomponentema. 
Dessutom beraknas en roll- ocb tippvinkel med bjalp av data frSn befintliga luftdata ocb 
befintliga anbl&sningsgivare, vilka data inkonmier via ledning 16 till matrutinen 21. Medelst 
det andra kalmanfiltret 22 skattas sedan i forsta band de attityd- ocb kursfel som uppstSr vid 
integrationen av styrsystemets vinkelbastigbetsgyrosignaler. I andra band anvands 
kalmanfilter 22 for att skatta nollfelen i vinkelbastighetsgyrosignalema, dvs nollfelen i p, q, 
ocbr. 



Den forsta matrutinen 10 



Det jordmagnetiska faltet kan beraknas teoretiskt over bela varlden. For att gora detta anvands 
exempelvis IGRF (International Geomagnetic Reference Field), 

Faltvektom i body frame betecknas bar med Bg ocb faltvektom i navigation frame med B^. 
Vidare betecknas de tre komponentema av faltvektom enligt 



B = [B^B^^BJ 



(6) 



Med hjalp av transformationsmatrisen , som transformerar en vektor frSn body frame 
till navigation frame, bar vi att 

dar bar utseendet 



^11 ^12 ^13 

^21 ^22 ^23 
C31 C32 C33 



(8) 
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Transfbrmationsmatrisen beraknas med hjalp av attityd bch kurs, " (9, <]>, ijf, frSn TNS. 



Skillnaden mellan uppmatt och enligt modellen beraknad faltvektor blir 

UppmM " ^//^ei^knad = ^ ' » . . . . - (9) 

dar 5 betecknar skillnaden i uppmatt storhet och beraknad. 

Vansterledet i ekv (9) blir utsignal frka den forsta matnitinen 10 och darmed insignal till 
kalmanfilter 11. Vidare utnyttjas hogerledet i ekv (9) i kalmanfiltret 11, vilket framgSr av 
beskrivningen av funktionen for det forsta kalmanfiltret 1 1 nedan. 



Det forsta kalmanfiltret 1 1 



Givet tillst&ndsmodellen 

si arbetar ett kalmanfilter enligt: 
Tidsuppd^ring 

dar lar skattad osakerhet for tillstinden efter tidsuppdateringen. 
Matuppdatering 

dar P^^i ar skattad osakerhet for tillstSnden'efter matuppdateringen. 
Felen i faltvektorkomponentema modelleras enligt 



(10) 



(11) 



(12) 



55. 



k S k 



5, 



(13) 
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dar b ar nollfel, s ar skalfaktorfel och k ar en korskoppling fr&n en komponent till en annan 
(tex sSl innebar index xy hur y-komponenten piverkar x-komponenten). Dessa 12 fel fSr 
representera tillstSnden i det forsta kalmanfiltiet 1 1 enligt 

"^k = [bjc by Sy k^^ ky^ ky^ k^ A:J (14) 

och tillstSndsekvationema ike var och en utseendet 

+ i = ^k-^^k^ (15) 
dar index k betecknar den tidsdiskreta upprakningen i tid. 

I ekv (15) ar wj^ ett svagt tidsdiskret processbrus for att modellera en viss drift i felen. Ekv 
(15) medfor att prediktionsmatrisen blir enhetsmatrisen och kovariansmatrisen for 

2 

processbruset blir enhetsmatrisen multiplicerat med , dar <s^ '^ satt till typiskt en 

hundratusendel (dimensionslost eftersom faltvektorkomponentema normeras till beloppet 1 
innan de utnyttjas). 

Nar det galler matuppdateringen av kalmanfilter 1 1 utnyttjas ekv (9) och matmatrisen fSr 
utseendet 



^11 ^12 ^13 ^ll^x ^\2^y ^13^z <^U^y ^ll^z ^12^z ^12^x ^13^jc ^n^y 
C21 C22 C23 C2iB^ <^22^y ^73^z ^21^y ^2\^z ^22^z ^22^x ^23^x ^23^y 
C31 C32 C33 C^iB^ ^32^y ^33^z ^3l^y ^3l^z ^32^z ^32^x ^33^x ^33^^ 



(16) 



P§L grund av omodellerade stomingar kommer uppmatt jordmagnetisk faltvektor att deviera 
firin modellen, bide till riktning och belopp. Den enklaste varianten ar att modellera dessa 
stomingar som ett konstant yitt matbrus med hjalp av matbruskovariansmatrisen Rj^. 
Standardawikelsen for matbruset for de tre faltvektorkomponentmatningama ar vardera satta 
till typiskt en tiondel (dimensionslost eftersom faltvektorkomponentema normeras till 
beloppet 1 innan de utnyttjas). 



For att undvika genomslag av dSliga m^tningar utnyttjas ett Chi2-test. Dessutom utnyttjas inte 
matningama av faltvektorkomponentema om vinkelhastighetema ar for hoga. Detta har sin 
grund i att diverse tidsfordrojningar slSr igenom vid hoga vinkelhastigheter. 
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Integrationsrutinen 20 



Man kan visa att tidsderivatan av transformationsmatrisen 

C?= C^'Wjs-Wj^'C^. (17) 
I ekv (17) ar Wj^ och Wjj^ B:s (Body firame) rotation relativt I (Inertial frame) respektive N:s 
(Navigation frame) relativt I, b&da skrivna i matrisform. 

Eftersom det bar handlar om reservattityd och reservkurs, dar kraven pS fel i attityd Sr av 
storleksordningen 2 grader, samtidigt som elementen i Wj^ ar av storleksordningen 0.01 - 

grader, forsummas W^^^ , Uttrycket i (17) blir di 

C?= C^'Wjs. (18) 

dar Wjg ar vinkelhastighetsgyrosignalema frSn styrsystemets vinkelhastighetsgyron. 

I princip innebar ekv (18) att man bar nio differentialekvationer. Pi grund av ortogonalitet 
behover endast sex av dessa integreras och de 6vriga tre kan beraknas med hjalp av 
kryssprodukten. 

Den andra matrutinen 21 

Den andra matrutinen 21 bestir av en utvecklad variant av den forsta matrutinen 11, dar 
utvidgningen bestir av en berakning av roll- och tippvinkel med hjalp av data frin luftdata 
(hojd och fart) och anblisningsgivama (anfallsvinkel och snedanblisningsvinkel). 

I den forsta matrutinen 21 antas att endast faltvektorkomponentema ar felaktiga och att attityd 
och kurs ar korrekta. Detta antagande ar rimligt pi grund av att en resolvering av 
faltvektorkomponentema sker med hjalp av attityd och kurs frin TNS. I den andra matrutinen 
21 ar detta inte uppfyllt, utan hansyn miste aven tas till fel i attityd och kurs. Faltvektom som 
anvands i den andra matrutinen 21 ar kompenserad for fel skattade i delsystem A. 

Fel i bide faltvektom och transformationsmatrisen ger att 
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dar Cb st3r for beraknad transformationsmatris cx:h betyder att 

Cb = cj[+8cj. _; (20) 

Utnyttjar vi (20), bildar skillnaden mellan uppmatt och beraknad faltvektor och forsummar 
prodxikter av fel fSs att 

Uppmatt ~ ^N, Beraknad ^ * Uppmatt ' ^^B • (21) 

I den andra matnitinen 21 sker aven berakning av roll- och tippvinkel med hjalp av hqjd, fart, 
anfallsvinkel och snedanblSsningsvinkel. Uppvinkeln kan beraknas enligt 

Gj^f = asin^^J + cos((|))a+ sm((|>)p (22) 

For att kunna berSkna tippvinkeln enligt uttrycket i ekv (22) kravs en hojdderivata. Denna 
hqjdderivata ar inte direkt tillganglig, utan den fSr beraknas utifr^ befintlig hqjd som erfaMls 
frin luftdata. Berakningen gors enligt 

A = /i(n) = l(^(^x-i)-A(n-l)+/i(n)-Mn-l)). (23) 

dvs en hogpassfiltrering av hojden. Beteckningama x och i ekv (23) representerar 

filtreringens tidskonstant respektive sampelfrekvens. Farten v som anvands i ekv (22) ar 
approximativt (sann fart relativt luften). Med approximativt menas att vid berakningen av 

V, anvands inte uppmatt temperatur, vilket ar det normala, utan bar utnyttjas en sk 
standardtemperaturfordelning. 

Vidare s& kan roUvinkeln beraknas enligt 

<I)„f = atani:^. (24) 

Uttrycket i ekv (24) galler endast for smi roll- och tippvinklar, smi vinkelhastigheter och 
dessutom att anfalls- och snedanbl&sningsvinklama ar sm&. 



Ovanst&ende tv& uttryck beraknas och jamfors med den attityd som beraknas via 
integrationsrutinen genom att skilkiaden bildas enligt 
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<|)-<|)_f = atan atan 



-33 



v(C 33-0^ + C32-a)y) 



7=r - ^ cos(atan|)a + sin(atan|)p). 



dar 



^ = atan— 
C33 



9 = atan 
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(25) 



(26) 



Det andra kalmanfiltret 22 



Det andra kalmanfiltret 22 kan sagas vara hjartat i systemet. Har skattas de attityd- och kursfel 
som uppstSr vid integrationen av vinkelhastighetsgyrosignalema frSn styrsystemet Skattning 
sker aven av nollfelen i vinkelhastighetsgyrosignalema. Vidare skattas eventuella iterst&ende 
fel i faltvektorkomponentema, dvs de fel som det forsta kalmanfiltret 1 1 inte kommer &t. AUt 
som allt innebar detta nio tillst^d; tre for attityd- och kursfel, tre for nollfelen i 
vinkelhastighetsgyrosignalema och tre for SterstSende fel i faltvektorkomponentema (tre 
noUfel). 

Attityd- och kursfel representeras med en vridning av det skrovf asta systemet (body frame) 
frSn beraknat till sant koordinatsystem. Felet i kan skrivas som 



^B 



B 



(27) 



Man kan Svertyga sig om att 



B 



1 -yz yy 



.-Yy Y. 



1 



= r+/, 



(28) 
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dar r ar matrisformen av y = [y^ y^, y^] och I ar enhetsmatrisen (T 

betecknar transponat). Elementen i vektom ybeskriver en liten rotation kring respektive axel 
mellan verkligt (sant) dch beraknat skrovfast system (body frame). Motsvarande 
differentialekvationer for elementen i y kan harledas till 

y = 5co , (29) 

dar 8(0 ar felen i vinkelhastighetema frSn vinkelhastighetsgyrona, 

Felen i vinkelhastighetema, modelleras som tre 1 :a ordningens MarkoA^rocesser enligt 

5co = -—8(0 + u^ (30) 

dar tidskonstahten x^^ ar satt till tjrpiskt ett antal tinmiar och de tre till typiskt mindre 
an en grad/sek. 

Pi ett liknande satt ar iterstSende fel i faltvektorkomponentema modellerade (noUfelen), dvs 
B = -lz>-hu^ (31) 

dar ar satt till typiskt ett antal tinmiar, ochw^ och ar satt till typiskt ett par hundradelar 

(dimensionslost eftersom faltvektorkomponentema normeras till beloppet 1 innan de 
utnyttjas). 

Detta ger en tillstSndsvektor enligt 

^Jt = [Xc Yy Yz ScO;c SCO, by b^ (32) 
och en prediktionsmatris enligt 

F^^ 1+ J A{x)dx. , r (33) 

t ■■■***" 
dar A(x) ar den matris som beskriver de tidskontinuerliga tillstSndsekvationema enligt ovan. 
Kovariansmatrisen for processbraset ar satt till en diagonalmatris. Som diagonalelement 

utnyttjas bla och beskrivna ovan. Nar det galler diagonalelementen kopplade till 

tillstSnden for attityd- och kursfel (de tre forsta) tas eflfektema av skalfaktorfelen i 
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vinkelhastighetsgyrosignalema med. Dessa skalfaktorfel ar normalt i storleksordningen 2% 
och kan ge stora fel i framintegrerad attityd och kurs vid hoga vinkelhastigheter. 



Matningarna ar fern till antalet; tre devierade faltvektorkomponenter och roll- och tippvinkel 
beraknade utifrSn luftdata Dessa matningar erhSlls genom att relationema (21) och (25) 
utnyttjas. 

Nar det galler matmatrisen H]^, utnyttjas relation (21) for att fylla de tre oversta radema. Detta 
ger att de tre oversta radema i matmatrisen utseendet 



(34) 



^13^y-^12^2 ^ll^z-^13^x ^I2^x-<^n^y 0 0 0 C^j C^j 
^23^y-^22^z ^21^z"^23^x ^22^;c-^21^y ^ 0 0 C23 
533^y-^32^z ^31^2 -^33^x ^32^x-^31^> 0 0 0 C31 C32 C33 

Till de tvi sista radema i Hj^ utnyttjas ekv (25) genom att de bida hogerleden differentieras 
med avseende p& alia tillst^d i det andra kalmanfiltret 22. Detta ger att de b&da sista radema 
f&r elementen (indexet betecknar rad och kolumn i namnd ordning) 



h4l = 1- 



g^(cJi + C2i)~ + V^CCjj • (Oj + C32 • (Hy)' 



2 .2 



/l42 = 



^43 = 



/I45 = 



^46 = 



2vg(-CnCx3-C2iC23)(C33a)^ + C32Q)y)-Vg(O^C3i(Cn +C21) C^^C^^ 
/(cJi + C2i)^ + V^(C33 - Q)^ + C32 • (Oy)^ C32 + ^3 

C12 + ^21^22)(^33^2 ^32^y) ^gQ^y^3l(^ll ^2l) ^^31*^33 



2. 2 



2 2 



(35) 



g (Cjl + Cji) + V (C33 • + C32 • (Oy) 

VgC32(cJi +C21) 



'32 *^33 



g^(Cii + C2i)^ + V^(C33 • + C32 • (n f 



g^ic]i + ^2\) + V^(^^33 • ®z +^32 • ®y)' 



och 
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h^i = sin^atan^^a- cosj^atan^^P 

^^^^-siri^atan^^a + cos^atan^Jpj 



^ 2 -Oh 



hs2 = 



2 
^32' 



^53 = 



(36) 



Ovriga element i fjarde och femte raden ar noil. 

Kovariansmatrisen for matbmset Rj^ valjs enklast till en diagonalmatris. De fyra forsta 
matbniselementen har en standardawikelse som Sr satta till typiskt en tiondel. Det femte 
matbruselementet daremot har en standardawikelse som ar satt till en funktion av 
hojdderivatan och farten. Funktionen ar belt enkelt en skalad sunmia av uttrycket for 
berakning av tippvinkel enligt ekv (25) differentierat med avseende pi hojdderivatan och 
farten. Funktionen ar satt till 



= 5- 




+ 50- 


9e„f 




dh 







(37) 



och ger ett mitt pi tippvinkelberakningens kanslighet for fel i hojdderivatan och farten. 
Eftersom felen i attityd och kurs beraknade med hjalp av integrationsrutinen snabbt vaxer, 
maste skattade attityd- och kursfel iterkopplas tillbaka till integrationsmtinen, vilket utfors 
med ledning 17. Gors inte detta blir felekvationema i det andra kalmanfilteret 22 snabbt 
ogiltiga pi gmnd av att ekvationema i gmnd och botten ar olinjara. Dessutom iterkopplas 
skattningama av noUfelen i vinkelhastighetsgyrosignalema via en ledning 18. Detta medfor en 
battre linjarisering av det andra kalmanfiltret 22 och dessutom kan sampelfrekvensen 
hillas nere. 



I en del flygsituationer ar de berakningar som utfors i den andra matrutinen 21 undermiliga, 
antingen pi grund av att matekvationema ej Sr tillrackligt anpassade eller att matdata i sig ar 
for bristfalliga. Berakningen av rollvinkeln utifrin luftdata anvands bara under planflykt. 
Ingen matning utnyttjas om vinkelhastighetema inte ar tillrackligt smi, typiskt nigon grad/ 
sek. Desutom sker en kontroU av matresidualema, dar matresidualema inte tillits overstiga 
typiskt en till tvi ginger tillhorande skattad osakerhet. 
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Beteckningar 



Koordinatsystem 



I (Inertial frame): ett i troghetsrymden fixt system. 

\^d flygning ovanfor jordytan ar det bnikligt att detta systems centrum sammanfaller med 
jordens centrum. I>etta ar egentligen en approximation eftersom ett system fix^ 
troghetsrymden inte fSr rotera. Pga att jorden roterar runt solen konraier aven I-systemet att 
rotera. Felet som uppkonmier ar emellertid forsumbart. De accelerationer och 
vinkelhastigheter som sensorema i ett troghetsnavigeringssystem mater ar relativt detta 
system. 

N (Navigation frame): ett system med centrum i flygplanet och med xy-planet hela tiden 
parallellt med jordytan. 

x-axehi pekar mot norr, y-axehi mot oster och z-axehi vertikalt ncdkt mot jordytan. 
B (Body frame): ett i flygplanet skrovfast system. 

Detta koordinatsystem roterar med flygplanet. x-axeln pekar ut genom nosen, y-axeln ut 
genom hogra vingen och z-axeln vertikalt nedit relativt flygplanet. 



Tabell 1 Forklaring av beteckningar for vinklar och vinkelhastigheter. Se 
ocksifigur4. 

<j) \^iikeln mellan y^ och horisontalplanet lutat med vin- 

keln e utmed (rollvinkeln). 

(|)^^ ^ Begynnelsevarde for rollvinkeln respektive skattad roU- 

vinkel 



(|)^^ Rollvinkeln beraknad med hjalp av data frSn Iftdata och 

kursderivatan . 



, e Vmkeln mellan Xq och horisontalplanet (tippvinkeln). 

e Begynnelsevarde for tippvinkehi respektive skattad tipp- 

vinkel 

Tippvinkeln beraknad med hjalp av data frSn luftdata och 
anblSsningsgivama 

= [<|), 6]^ Komprimerad beteckning av rollvinkeln och tippvinkeln 
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Tabell 1 Forklauing av beteckningar for vinklar 
ocks^ figur 4. 



<p, (Po,Acp.. 




Skattad roll- och tippvinkel, skattade begyimelsevarden 






for roll- och tippvinkeln respektive skillnaden mellan 
framintegrerad och referensberaknad roll- och tippvinkel 


<Pref. <PAHRS 




Roll- och tippvinkeln beraknade med hjalp av luftdata 
och primardata respektive franiintegrenid roll- och tipp- 
vinkel dar integrationen sker med hjalp av vinkelhastig- 
hetsgyrosignalema 


1 




Vinkeln mellan projektionen av i horisontalplanet 
och norr (kursvinkeln) respektive tidsdiskret indexering 
av kursvinkeln 


a 




Vinkeln mellan luftrelaterad hastighetsvektor projicerad 
pi z-axelh i body frame respektive projicerad p& x-axeln i 
body frame (anfalls-vinkeln) 


P 




Vinkeln mellan luftrelaterad hastighetsvektor och luftrela- 
terad hastighetsvektor projicerad pi y-axeln i body frame 
(snedanblisningsvinkeln) 






Transformationsmatris (3x3 matris) som transformerar 
en vektor frin body frame (verkligt) till navigation frame. 
Elementen i denna matris betecknas c^j, 0^2^ C13, C21, 022* 
C23, C31, C32, C33 dar indexen betecknar rad och kolunm i 
namnd ordning 


^ B 


~IN ^^T^ 

B 


Transformationsmatris som transformerar en vektor frin 
body frame (beraknat) till navigation frame 






Skillnad mellan beraknad och sann 




Vridning kring x-, y- respektive z-axeln i body frame 
motsvarande felet mellan sant och beraknat body frame 


r 




Antisymmetriska matrisformen av vektom y 


COy^ = CO = 




Vinkelhastighet kring x-, y- respektive z-axeln i body 
frame (vinkelhastighetsgyrosignalema). Dessa vinkel- 
hastighetskomponenter bmkar ocksi betecknas med 






Vektom (O;^ uttryckt i antisymmetrisk matrisform 


8(0 = ( ScOjf, 8(Dy, 6a)j)^ 


Skillnad mellan verklig och uppmatt vinkelhastighet 
kring X-, y- respektive z-axeln i body frame 






Rotationen av navigation frame relativt inertial frame som 
uppstir vid forflyttning over den kroktajordytan. Anti- 



symmetrisk matrisform 
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TabeU 2 


Forklaring av beteckningar for jordmagnetiska faltet 






Jordmagnetiska faltvektorkomponentema i body frame 


hB^ SBy, 


hB, 


Skillnaden mellan uppmatta och verkliga faltvektor- 
komponenter i body frame 


B^fBg 




Jordmagnetiska faltvektom i navigation frame respek- 
tive body frame 


TabeU 3 


Forklaring 


av beteckningar som anvands i samband med filter 


/C, /C + 1 




Anvands som index och representerar tidpunkten 
I ore rcapciviivc ciicr uuduppuaienng 


rt, n + 1 




Anvands for att representera nuvarande respektive 
eiicnoijanae sompci 






Anvands som index och representerar tidpunkten 
lore respcKxivc eixer inaiuppaaicnng 


a:, z, P 




TillstSndsvektom, matvektom respektive skatt- 
ningsoaa&crncioiiiaLrisen 






X roccadurudVCKiorn respeK.iivc KOVanansmauiscn 
for processbruset 


A,F 




Prediktionsmatrisen i tidskontinuerlig respektive 
tidsdiskret form 


K,H,R 




Kalmanforstarkningsmatrisen, matmatrisen respek- 
tive kovariansmatrisen for matbruset 


"<o> "b' 




Drivande brus for markovprocessema 


'^00' '^b> '^s* 




Tidskonstanter 


fs 




Sampelfrekvens 



TabeU 4 Forklaring av Svriga beteckningar. Se ocks& figur 5. 



by, b^ 


Bias (nollfel) 




Skalfaktorfel 


k k k k k k 
'^xy^ '^xv '^yx* "-yr '^zx> '^zy 


Korskopplingsfel (exempelvis stSr index xy for hur y- 


komponenten piverkar jc-komponenten). Uppkonmier 




pga att axlama i en triad i verkligheten inte ar ortogonala 
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Tabell 4 Forklaring av ovriga beteckningar. Se ocksi figur 5. 





Hojd respektive ligpassfiltrerad tidsderiverad hdjd 




Verklig fart leladvt luften 




Gravitationen 
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PATENTKRAV 



1 . Metod for att syntetiskt berakna rcservattityd for ett flygplan nar flygplanets kurs ar 
kand med hjalp av i flygplanet befintliga data, sSsom vinkelhastighetema p, q, r kring ett • 
skrovfast koordinatsy stems (body frame) x-, y- och z- koordinater , luftdatainformation i fprin^ 
av fart, hojd och anfallsvinkel samt kursinformation, kannetecknad av att metoden mnefattar 
stegen: . \- 

- attityden beraknas med utglmgspunkt frSn de skrovfasta vinkelhastighetema p, q, r och- ^ 

- den beraknade attityden korrigeras medelst luftdata och kurs. 

2. Metod enligt patentkrav 1, kamietecknad av att kursinformationen erhSlls frSn ett 
kursgyro. 

3. Metod enligt patentkrav 1 eUer 2, kamietecknad av att attityd integreras fram via 
information om flygplanets skrovfasta vinkelhastigheter (p, q och r) erhSllna ur flygplanets 
skrovfasta vinkelhastighetsgyron. 

4. Metod enligt patentkrav 3 , kamietecknad av att korrigering av framintegrerad 
attityd sker med hjalp av attityd beraknad utifrSn luftdatainformationen samt kursinformation. 

5. Metod for att syntetiskt berakna reservattityd och reservkurs for ett flygplan med 
hjalp av i flygplanet befintliga data, s^om vinkelhastighetema p, q och r kring ett skrovfast 
koordinatsystems (body frame) x-, y- och z- koordinater och luftdatainformation i form av 
fart, hojd och anfallsvinkel, kannetecknad av att metoden innefattar stegen: 

- attityd och kurs beraknas med utgSngspunkt frSn de skrovfasta vinkelhastighetema p, q och r, 

- felen i de uppmatta skrovfasta magnetiska faltvektorkomponentema skattas, 

- de uppmatta skrovfasta magnetiska faltvektorkomponenterria devieras, 

- fel i beraknad attityd och kurs skattas med hjalp av luftdata samt devierade uppmatta 
skrovfasta magnetiska faltvektorkomponenter och 

- den beraknade attityden och kursen korrigeras med skattade fel i attityd och kurs. 
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6. Metod enligt patentkrav 5, kannetecknad av att attityd och kurs integreras fram via 
information om flygplanets skrovfasta vinkelhastigheter (p, q och r) erhMlna nr flygplanete 
skrovfasta vinkelhastighetsgyron. 

7. Metod enligt patentkrav 5, kannetecknad av att skattning av fel i uppmatta 
skrovfasta niagnetiska faltvektorkoniponenter utfors i ett forsta filter 

8. Metod enligt patentkrav 6 eller 7, kannetecknad av att i ett andra filter (22) utfors 
skattning av attitydfel och kursfel som uppkommer vid integration av flygplanets skrovfasta 
vinkelhastigheter (p, q och r) erhSllna ur flygplanets skrovfasta vinkelhastighetsgyron, dSr 
skattningen gors med hjalp av attityd beraknad frSn luftdatainformation samt devierade 
uppmatta skrovfasta magnetiska faltvektorkoniponenter. 

9. Metod enligt patentkrav 7 eller 8, kannetecknad av att filtreringen sker med hj^p av 
kalmanfilter. 

10. Anordning for att syntetiskt berakna reservattityd for ett flygplan nar flygplanets kurs 
ar kand med hjalp av i fly gplanet befintliga data sSsom flygplanets skrovfasta 
vinkelhastigheter (p, q och r), luftdata innefattande &tminstone fart, hojd och anfallsvinkel 
samt kursinformation, kannetecknad av att anordningen innefattar en integrationsrutin (8) 
for att integrera fram flygplanets attityd ur information om flygplanets skrovfasta 
vinkelhastigheter (p, q och r) samt att den beraknade attityden korrigeras medelst 
referensattityd ur luftdata och reservkurs. 

1 1 . Anordning enligt patentkrav 10, kannetecknad av att kursinf ormationen erhSUs frSn 
ett kursgyro. 

12. Anordning enligt patentkrav 10 eller 1 1, kannetecknad av att integrationsrutinen (8) 
integrerar fram flygplanets attityd ur flygplanets skrovfasta vinkelhastigheter (p, q och r) 
erhSllna frSn flygplanets skrovfasta vinkelhastighetsgyron. 



13. Anordning enligt patentkrav 12, kannetecknad av att integrationrutinen (8) matas 
med nollfelskompenserade skrovfasta vinkelhastighetsgyrosignaler. 
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14. ' Anordning enligt patentkrav 10, kaiinetecknad av att man med luftdatainformation 
samt reservloirsihfonnation beraknar en referensattityd. 

15. Anordning enligt patentkrav 10, kannetecknad av att en syntetiskt genererad 
korrigerad attityd erhSlles genom att en skillnad bildas mellan den ur integrationsrutinen (8) 
erhMlna attityden och en felsignal som representerar felet mellan den integrerade attityden och 
referensattityden. 

1 6. Anordning for att syntetiskt berSkna reservattityd och reservkurs for ett flygplan med 
hjalp av i flygplanet befintliga data, sSsom uppmatta skrovfasta magnetiska 
faltvektorkomponenter, flygplanets skrovfasta vinkelhastigheter p, q och r samt luftdata 
innefattande itminstone fart, hojd och anfallsvinkel, kannetecknad av att anordningen 
innefattar en fcirsta matnitin (10) som transformerar de uppmatta skrovfasta magnetiska 
faltvektorkomponentema till flygplanets navigeringssystem (navigation frame), ett forsta filter 
(1 1) som skattar felen i de beraknade uppmatta skrovfasta magnetiska 
faltvektorkomponentema, en integrationsratin (20) for att integrera fram flygplanets attityd 
och kurs ur information om flygplanets skrovfasta vinkelhastigheter (p, q och r), ett andra filter 
(22) for skattning av felen uppkonma i attityd och kurs ertiSllna vid nanmda integration och en 
andra matratin (21) for berakning av attityd och kurs ur luftdata och devierade uppmatta 
skrovfasta magnetiska faltvektorkomponenter. 

17. Anordning enligt patentkrav 16, kannetecknad av att den forsta matrutinen (10) 
matas med de uppmatta skrovfasta magnetiska faltvektorkomponentema samt attityd och kurs 
frSn flygplanets ordinarie navigeringssystem och transformerar de uppmatta skrovfasta 
magnetiska faltvektorkomponentema till flygplanets navigation frame. 

18. Anordning enligt patentkrav 17, kannetecknad av att det forsta filtret (11) matas med 
infomiation frSn den forsta matmtinen (10) och skattar felen i de uppmatta skrovfasta 
magnetiska faltvektorkomponentema. 



: .• ■". ■ . r ' ' ■ PCT/SE 00/0003 4 



24(2S) 

^2 -Oh 2000 

19. Anordning enligt patentkrav 16, kannetecknad ay att integrationsmtinen (20) 
integrerar fram flygplanets attityd och kurs nr flygplanets skrovfasta vinkelhastigheter (p, q 
och r) erhSllna frSn flygplanets skrovfasta vinkelhastighetsgyron. 

20. Anordning enligt patentkrav 1 6, kannetecknad av att den andra matrutinen (21) 
matas med luftdata, de devierade uppmatta skrovfasta magnetiska faltvektorkomponenteina 
och med information om flygplanets skroyfasta vinkelhastigheter (p, q och r) och ur dessa 
varden beraknar en attityd och kurs. 

21. Anordning enligt patentkrav 20, kannetecknad av att det andra filtret (22) matas 
med information frSn den andra matrutinen (21) och skattar felen i attityd och kurs samt 
noUfel i skrovfasta vinkelhastighetsgyrosignaler och &terstiende fel i de uppmatta skrovfasta 
magnetiska faltvektorkomponentema for generering av en felsignal. 

22. Anordning enligt patentkrav 21, kannetecknad av att en syntetisktgenererad 
korrigerad attityd och kurs erhilles genom att en skillnad bildas mellan 

- den ur integrationsmtinen (20) erhSllna attityden och kursen och 

- felsignalen frin det andra filtret (22). 

23. Anordning enligt patentkrav 19, kannetecknad av att integrationmtinen (20) matas 
med skrovfasta vinkelhastighetsgyrosignaler kompenserade for skattade noUfel. 



24. Anordning enligt n&got av patentkraven 16-23, kannetecknad av att det forsta filtret 
(1 1) och/eller det andra filtret (22) utgors av ett kalmanfilter. 
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SAMMANDRAG 

En metod och en anordning for att syntetiskt berakna reservattityd och reservkurs medelst i ett 
flygplan befintliga data. \^d ett utforande finns flygplanets kurs tillganglig och vid ett annat 
utforande beraknas kursen utifr^ en magnetisk kursgivare. Di kursen ar tillganglig 
(reservkurs) sker berakningen av attityd genom sanunanvagning av signalema frSn 
vinkelhastighetsgyrona (2) i flygplanets styrsysteni/infonnation fr&n luftdata (hqjd, fart, 
anfallsvinkel) samt information om kurs (reservkurs). P& kursen inte ar tillganglig sker 
berakningen av attityd och kurs enligt ett utforande med hjalp av kalmanfilter (1 1, 22) genom 
sanmianvagning av signalema frSn vinkelhastighetsgyrona i flygplanets styrsystem, 
information frSn luftdata (hqjd, fart, anfallsvinkel och snedanblisningsvinkel) samt 
information frSn en i flygplanet befintlig magnetkursdetekton (Fig. 3). 
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Redundant system for the indication of heading and attitude in an aircraft 
TECHNICAL FIELD 

The invention relates to a system function which provides display of heading and attitude on 
displays in an aircraft, for example a head-up display (HUD), in the event of failures in certain 
equipment for normal attitude display. The system function, which in English is called 
Attitude and Heading Reference System and is abbreviated AHRS with reference to its 
initials, supplements the aircraft's normal display for heading and attitude. This display is 
intended to help the pilot to recover from difficult attitudes and then facilitate return to base/ 
landing. 

PRIOR ART 

In order not to lose attitude and heading display in an aircraft in the event of failure of a 
normally-used inertial navigation system (INS) a redundant system is required. In good 
visibility a pilot can fly by using the horizon as an attitude reference, but with great 
uncertainty as to the heading. In bad weather, in cloud and at night when the horizon is not 
visible, the pilot can easily become disoriented and thereby place the aircraft and him/herself 
in hazardous situations. 

AHRS systems calculate, independently of normal systems, attitude angles (pitch and roll) and 
heading. Such a system continuously displays the position to the pilot on a display in the 
cockpit. The need for a redundant system for attitude may be so great that an aircraft is not 
permitted to fly without one. 

Redundant systems in the form of an AHRS unit are available today. Such a unit contains 
among other things gyros which measure aircraft angle changes in pitch, roll and yaw. It also 
contains accelerometers and magnetic sensor. The accelerometers are used to establish a 
horizontal plane. The magnetic sensors are used to obtain a magnetic north end. This type of 
AHRS system in the form of hardware is costly and involves the installation of heavy, bulky 
equipment on the aircraft. To overcome this there is proposed in this description a synthetic 
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AHRS which uses sensors existing in the aircraft, which are not normally intended for AURS 
calculation and which therefore partly have significantly lower performance, instead of 
sensors of the type included in an AHRS unit. 

The angles are calculated with the aid of existing sensors in the aircraft. The aim is to use 
existing angular rate gyro signals and support these with calculations based on other available 
primary data in the aircraft. Angular rate gyros are normally used in control systems and 
generally have substantially greater drift than gyros for navigation. 

DESCRIPTION OF THE INVENTION 

According to one aspect of the invention, a method is provided for synthetically calculating 
redundant attitude and redundant heading by means of data existing in an aircraft as specified 
in the claims. 

Different forms of embodiment have been developed. In one embodiment the heading of the 
aircraft is available and in another embodiment the heading is calculated on the basis of a 
magnetic heading sensor. When the heading is available the calculations can be substantially 
reduced. 

When the heading is available (redundant heading) attitude is calculated by weighting together 
the signals from the angular rate gyros in the flight control system of the aircraft, information 
from air data (altitude, speed, angle of attack) and information about heading (redundant 
heading). 

When the heading is not available, attitude and heading are calculated according to one 
embodiment with the aid of Kalman filters by weighting together the signals from the angular 
rate gyros in the aircraft's control system, information from air data (altitude, speed, angle of 
attack and sideslip angle) as well as information from an existing magnetic heading detector in 
the aircraft. 

One advantage of a synthetic AHRS according to the aspect of the invention is that it works 
out substantially cheaper than conventional AHRS system based on their own sensors if 
existing sensors in the aircraft can be used. This also saves space and weight in the aircraft. 
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DESCRIPTION OF FIGURES 

Figure 1 shows a schematic diagram of an AHRS function in which the heading is available. 

Figure 2 shows the principle for levelling of the attitude of the aircraft in a head-up display, to 
the left without levelling and to the right with levelling. 

Figure 3 shows the block diagram of a redundant system for both attitude and heading. 

Figure 4 shows in three pictures the attitude and heading of the aircraft and the axes in the 
body frame coordinate system, as well as the angle of attack and the sideslip angle. 

Figure 5 shows how zero errors and scale factor errors impact the measured value. 
DESCRIPTION OF EMBODIMENT 

A number of embodiments are described below with the support of the figures. According to 
the invention, methods are provided for synthetically calculating attitude and heading by 
means of data existing in the aircraft as specified in the claims. 

In a simpler embodiment, the heading of the aircraft is available. In another embodiment the 
heading is calculated, in this case on the basis of a magnetic heading sensor. 

Calculation of AHRS when the heading is known 

The signals from the three angular rate gyros 2 rigidly mounted on the body frame are used to 
determine the orientation of the aircraft relative to the reference coordinate system N 
(navigation frame). The angular rate gyros 2 measure angular velocities around the three body- 
frame coordinate axes (x, y, z). The angular velocities are normally designated or p 
(rotation around the x-axis), cOy or q (rotation around the y-axis) and co^ or r (rotation around 
the z-axis). The orientation between the body-frame coordinate system B (body) and the N 
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system is given by the euler angles 6, 0 and \\f. However, since the heading is known, only 9 
and 4) are of interest. With the assumption that the N system is an inertial system and is 
oriented so that its z-axis is parallel to the g vector of the earth, it can be shown that 



0 



co^cos<t) - C02sin<t) 
co„ + tanSCcOySinct) + co,cos(()) 



(1) 



If the gyros 2 were ideal, the initial values and Gq were error-free and if the integration 
method used were accurate, attitude angles can be obtained by solving Eqn (1). In practice, 
however, none of these preconditions is satisfied; instead, sensor errors etc cause the solution 
to diverge and relatively soon to become unusable. 

Sensor errors in the form of among others zero errors, scale factor errors, misaligned mounting 
and acceleration-induced drifts constitute the dominant sources of error. In level flight the zero 
error is the error source that dominates error growth. 

Owing to sensor imperfections and uncertainty in initial values, equation (1) gives an estimate 
of roll and pitch angle derivatives according to 



e 



co^cos^ - o>,sin^ 
co^ + tane(Q)ySin^ + o)^cos$) 



(2) 



The difference between the expected <pAHRS (calculated by the AHRS function) and the 
"actual" (pref (from air data, primary data calculated) attitude angles constitutes an estimate of 
the attitude error 

A(p = ipAHRS - 9ref 

See below concerning the use of A(p. 
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Finally the attitude angles are given as 

(?AHRS = j^^dt-i-i^o-limiAq)) (4) 
where cpo constitutes estimated initial values. 

Calculation of cpj-^f 

The formula Qref = arcsin ih/\{) + (a * cos (j)) is used when calculating Bj-ef- ^ is a high-pass- 
filtered altitude signal, v^ is true airspeed. 

The formula <t)ref = arctan (Vj * (x}/)/g) is used when calculating ^^ef. 
y is a high-pass-filtered heading (redundant heading) signal. 



Zero correction of the angular rate gyros 

The zero errors in the angular rate gyros 2 are heavily temperature-dependent. It may take 20 
to 30 minutes for the gyros to reach operating temperature. This means that an E^S failure 
shortly after take-off might give large zero errors if flying continued. However, it takes a 
certain time from gyros 2 receiving voltage to the aircraft taking off, which means that part of 
the temperature stabilisation has been completed when a flight begins. It is also assumed that 
landing can take place within a short time in the event of an INS failure during takeoff. To 
minimise zero errors from the angular rate gyros 2 a zero correction of the angular rate gyros 
is performed by software. This involves comparing the co (p, q and r) signals from the angular 
rate gyros 2 with the corresponding signal from the INS, see eqn (5), by generating a 
difference in 4a. The difference is low-pass-filtered in a filter 5 and added to the angular rate 
gyro signals in a difference generator 4b, where the signal coj^ which designates the zero-error- 
corrected gyro signals and is used instead of co in the AHRS calculations. This is done 
continuously as long as the INS is working. In the event of an INS failure the most recently 
performed zero corrections are used for the rest of the flight. 



5 



wo 00/42482 



PCT/SEOO/00034 



<^TNS = 











Ptns 












S 





-97-^5 sin (|)7/s^5 + ^tnsOOsQtns^^^^tns_ 



(5) 



A block diagram of the realisation of the AHRS function with zero correction of the angular 
rate gyros is shown in Figure 1 . The figure gives a schematic illustration of the AHRS 
function. The zero correction of the angular rate gyros is performed by the units inside the 
dashed area D. 

VtnS' ^TNS ^TNS high-pass-filtered to obtain ^tns » ^TNS ^tns- These are used 
in Eqn (5), which gives o^ms ( Pjns. <1tnS' ^tns) ^ ^^^^ block 1. co ( p, q, r) which are 
obtained as signals from the gyros designated by 2 are low-pass-filtered in a low-pass filter 3, 
before the difference is generated in 4a. 

The difference signal between the co^ns ( PtnS' ^TNS* ^tns) signals and the co ( p, q, r) signals 
is low-pass-filtered with a long time-constant in a low-pass filter 5^ ie its mean value is 
generated over a long time. The filter 5 is initialised at take-off rotation with the shorter time- 
constant. After a power failure, the filter 5 is initialised instantaneously. 



In block 7, cp is calculated, after which the integration according to Equation (4) is performed 

in an integrator 8, to which the initial conditions (po are added. In a difference generator 9a 
the signal A(p is added, but is disconnected by means of a switch 9b under certain changeover 
conditions, as for example when \y\ > and \<^\ > (^um- The A(p signal passes through a 
limiter 9c. The magnitude of the output signal from the limiter 9c is dependent on the 
magnitude of the Acp signal (ie the input signal to limiter 9c). The A9 signal is generated 

according to Equation (3) in a difference generator 9d to which are added calculated (pAHRS 
attitude angles and ''actual" (p^^f attitude angles from sensors (primary data) designated with 
9e. 



Despite compensations, the calculated angles from the AHRS contain minor zero errors. Since 
the output signals are used for head-up display, this is corrected by using A(|) in roll and A6 in 
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pitch to level the SI image until a stable position is obtained. See Figure 2, where the line H 
symbolises the actual horizon and where an aircraft is represented by P. Note that this levelling 
of the HUD only takes place when one is within the limits described above. 

AHRS calculation when the heading is also to be calculated 

Figure 3 shows schematically the modules that form building blocks for another variant of a 
synthetic AHRS and how these modules are linked together to create a redundant attitude and 
a redundant heading. 

Figure 3 shows the principle of the redundant system in accordance with the aspect of the 
invention. The system consists of two subsystems A and B; the first subsystem A performs 
estimation of any errors in the measured geomagnetic field and the other subsystem B 
performs calculation of redundant attimde and heading. In all, this results in five building 
blocks, where a first measurement routine 10 and a first Kalman filter 11 constitute the 
building blocks in the first subsystem A and further where the integration routine (1/s) 20» 
measurement routine 21 and a second Kalman filter 22 constitute the building blocks in the 
second subsystem B. 

With measurement routine 10, measured field vector components in the body frame coordinate 
system are transformed, to a north-, east- and vertically-oriented coordinate system called the 
navigation frame. The transformation takes place with the aid of attitude and heading from the 
inertial navigation system of the aircraft, ENS, via wire 12. The field vector components of the 
geomagnetic field are taken from a magnetic heading sensor in the aircraft and arrive via wire 
13. In the first Kalman filter 1 1, the errors in the field vector components are then estimated on 
the basis of knowledge about the nominal nature of the components, after which the estimated 
values are stored in a memory 14. 

Subsystem A (measurement routine 10 and Kalman filter 11) are used only when the INS is 
working correctly. In the event of INS failure, the latest possible estimate of the errors in the 
field vector components is used, ie that which has been stored in memory 14. Since it may be 
difficult in many cases to decide whether the INS is working as it should, the absolutely last 
estimate should not be used. In order to solve this, the estimates of errors in the measured 
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geomagnetic field that are used are at least one flight old. ie the estimates that are stored in the 
memory from the previous flight or earlier. 

The integration routine 20 receives information about angular velocities, in this case for the 



(rotation around the x-axis), co^ or q (rotation around the y-axis) and co^ or r (rotation around 
the z-axis). The information is taken from the angular rate gyros of the control system and is 
fed via wire 15 to routine 20 which integrates out attitude and heading via a transformation 
matrix. 

The second measurement routine 21 consists of a developed variant of the first measurement 
routine 1 1 and uses the field vector components derived from the first measurement routine 
II. In addition, a roll and pitch angle are calculated with the aid of data from existing air data 
and existing slip sensors, data which arrives to measurement routine 21 via wire 16 to 
measurement routine 21. By means of the second Kalman filter 22 the attitude and heading 
errors that arise on integration of the angular rate gyro signals of the control system are 
primarily calculated. Secondarily, Kalman filter 22 is used to estimate the biases in the angular 
rate gyros, ie the biases in p, q, and r. 

The first measurement routine 10 

The geomagnetic field can be calculated theoretically all over the world. To do this, the IGRF 
(International Geomagnetic Reference Field) is used, for example. 
The field vector in the body frame is designated here with B3 and the field vector in the 
navigation frame with B^, Further, the three components of the field vector are designated in 
accordance with 



three coordinate axes x, y and z in the body frame. These are normally designated co^ or p 
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where has the appearance 



cf - 



11 ^12 ^13 



'21 22 ^23 



(8) 



-31 ^32 ^33_ 

The transformation matrix is calculated with the aid of attitude and heading, 9, (]), \\f, from 
the INS. 

The difference between a measured field vector and a field vector calculated in accordance 
with the model will be 

^A^, measured ~ ^N, calculated = ^ ' ^^B 

where 5 designates the difference between the measured and the calculated quantity. 
The left-hand part of Eqn (9) becomes the output signal from the first measurement routine 10 
and thus the input signal to Kalman filter 1 1 . Further, the right-hand part of Eqn (9) is used in 
Kalman filter 1 1 , which is evident from the description of the first Kalman filter 1 1 below. 



The first Kalman filter 1 1 

Given the state model 
+ 1 = ^k^k ^k 

(10) 

^k = ^k^k-^^k^ 
a Kalman filter works in accordance with: 



Time updating 

(11) 



^jt+l - ^k^k 



^Jfc+1 = ^kK^k'^Qk^ 
where P]^^x is the estimated uncertainty of the states after time updating. 
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Measurement updating 

T - 7* -1 

where 1 is the estimated uncertainty of the states after measurement updating. 
The errors in the field vector components are modelled according to 



(12) 
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where b are biases, s are scale factor errors and k is a cross-coupling from one component to 
another (for example, index xy refers to how the y-component affects the x-component). These 
12 errors can represent the states in the first Kalman filter 1 1 according to 



b,, b, s,, k^,, k^, k,^ k^^ k. 



Y 

yj 



k "^y z "^x "^y '"xy '^xz '"yz '"yx '"zjc '^zy^ 

and each of the state equations looks like this 
where the index k designates the time-discrete count-up in time. 



^-Jt + 1 - ^k'^'^k- 



(14) 



(15) 



In Eqn (15), wj^ is a weakly time-discrete process noise to model a certain drift in the errors. 
Eqn (15) means that the prediction matrix becomes the unit matrix and the covariance matrix 

2 

for the process noise will be the unit matrix multiplied by , where is typically set to 

one hundred-thousandth (dimensionless since the field vector components are normalised to 
the amount 1 before they are used). 



Where measurement updating of Kalman filter 1 1 is concerned, Eqn (9) is used and the 
measurement matrix looks like this 



Cii5^ c^^By Ci35^ c^^By c^^B^ c^^^^ c^^B^ c^^B^ c^jBy 

C21 C22 C2\B^ f^n^y (^n^z ^2\By ^2\Bz ^ll^z ^ll^x ^n^x ^23^y 
C3J C32 C33 C3j5^ ^32^}- <^33^z ^31^y ^3I^z ^32^z ^32^a: ^33^r ^33^^. 



(16) 
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Owing to unmodelled interference, the measured geomagnetic field vector will deviate from 
the model, both in direction and in amount. The simplest variant is to model this interference 
as a constant white measurement noise with the aid of the measurement noise covariance 
matrix Rj^. The standard deviations for the measurement noise for the three field vector 
component measurements are each typically set to one-tenth (dimensionless because the field 
vector components are normalised to 1 before they are used). 

A Chi2 test is used to avoid the impact of bad measurements. In addition^ the measurements of 
the field vector components are not used if the angular velocities are too high. The reason for 
this is that various time delays exert an effect at high angular velocities. 



Integration routine 20 

It can be shown that the time-derivative of the transformation matrix becomes 

= dl-^lB-^lN-C^B- (17) 

In Eqn (17) Wjg and Wjj^^ are, respectively, B's (body frame) rotation relative to I (inertial 
frame) and N*s (navigation frame) rotation relative to I. Both are written in matrix form. 
Since we are concerned with redundant attitude and redundant heading, where the 
requirements for attitude errors are of the order of 2 degrees, whilst the elements in Wjjvj are of 

the order of 0.01 degrees, W^^ is disregarded. The expression in (17) will then be 

C? = C^. WjQ, (18) 
where Wjg is the angular rate gyro signals from the angular rate gyros of the control system. 

In principle Eqn (18) means that there are nine differential equations. Because of 
orthogonality, only six of these need be integrated and the other three can be calculated with 
the aid of the cross-product. 
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The second measurement routine 21 consists of a developed variant of the first measurement 
routine 1 1, in which the expansion consists of calculating the roll and pitch angles with the aid 
of data from air data (altitude and speed) and the slip sensors (angle of attack and sideslip 
angle). 

In the first measurement routine 11 it is assumed that only the field vector components are 
incorrect and that attitude and heading are correct. This assumption is reasonable because the 
field vector components are resolved with the aid of attitude and heading from the EsTS. In the 
second measurement routine 2 1 this is not satisfied, and consideration must also be given to 
attitude and heading errors. The field vector used in the second measurement routine is 
compensated for errors estimated in subsystem A. 

Errors in both the field vector and the transformation matrix mean that 

^N, Measured - ' ^ Measured (19) 

where Cb stands for calculated transformation matrix and means that 

Cb = C^ + Scjf. (20) 

If we use (20), generate the difference between measured and calculated field vector and 
disregard error products, we get 

^N, Measured ~ ^N, Calculated ^ * ^N, Measured ' ^^B • (21) 

In the second measurement routine 21, roll and pitch angle are calculated with the aid of 
altitude, speed, angle of attack and sideslip angle. The pitch angle can be calculated according 
to 

^ref = asin^^j + cos(<())a+ sin(<(>)p (22) 

To be able to calculate the pitch angle according to the expression in Eqn (22) an altitude 
derivative is required. This altitude derivative is not directly accessible and must instead be 
calculated on the basis of existing altitude which is obtained from air data. The calculation is 
done according to 
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h = 




(23) 



ie a high-pass filtering of the altitude. The symbols x and in Eqn (23) represent 
respectively the time-constant of the filtering and the sampling frequency. The speed v used in 
Eqn (22) is approximately (true speed relative to the air). By approximately we mean that, 
when calculating , measured temperature is not used, which is the normal case, but a so- 
called standard temperature distribution is used here instead. 

Further, the roll angle can be calculated according to 



The expression in Eqn (24) appUes only for small roll and pitch angles, small angular 
velocities and moreover when the angles of attack and the sideslip angles are small. 

The above two expressions are calculated and compared with the attitude that is calculated via 
the integration routine by generating the difference according to 



^ref = atan-^. 



(24) 



atan — = - atan 



V(C33 ■ CO, C32 ■ COy) 



^(^11+^21) 



(25) 



e-e 



'ref 



= atan 




where 



<() = atan— 
C33 



6 — atan 




(26) 



¥ = 



C33 • CO^ + • COy 
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The second Kalman filter 22 

The second Kalman filter 22 can be said to be the heart of the system. Here are estimated the 
attitude and heading errors that arise on integration of the angular rate gyro signals from the 
flight control system. Also estimated are the zero errors in the field vector components of the 
angular rate gyro signals. Further, possible residual errors in the field vector components, ie 
the errors that the first Kalman filter 1 1 cannot reach are estimated here. All in all, this means 
nine states: three for attitude and heading errors, three for the zero errors in the angular rate 
gyro signals and three for residual errors in the field vector components (three zero errors). 
Attitude and heading errors are represented by a rotation of the body-frame system from a 

calculated to a true coordinate system. The error in can be written 

5c^ = £rc2; = c2.rf-ci = c2;.(rf-/). (27) 

One can ascertain that 



B 



1 -Yz yy 

-yy Xc 1. 



= r+/ , (28) 



T 

where T is the matrix form of y = [J^y Yy» 7^] and I is the unit matrix (T means transponate). 

The elements of the vector y describe a small rotation around the respective axis between 
actual (true) and calculated body frame system. The corresponding differential equations for 
the elements of y can be derived to 

y = 5co , (29) 
where 5q) is the errors in the angular rates from the angular rate gyros. 

The errors in the angular rates are modelled as three first-order Markov processes according to 
5'co = —Sco + (30) 

where the time-constant is set typically to a number of hours and the three to typically 
less than one degree/second. 

Residual errors in the field vector components are modelled (the zero errors) in a similar way, 
ie 



14 



wo 00/42482 



PCT/SEOO/00034 



B^—b-hu^ (31) 

where is set typically to a number of hours, and is set typically to a few hundredths 
(dimensionless because the field vector components are normalised to 1 before they are used). 

This gives a state vector according to 

^it = [Yx Jy Jz 5co^ SCO, by b2^ (32) 
and a prediction matrix according to 

Ff^ = I-^ J A(x)rfT, (33) 

where A(x) is the matrix that described the time-continuous state equations as above. 
The covariance matrix for the process noise Qj^ is set to a diagonal matrix. Among other 

things, and described above are used as diagonal elements. As regards the diagonal 

elements linked to the states for attitude and heading errors (the first three), the effects of the 
scale factor errors in the angular rate gyros are included. These scale factor errors are normally 
of the order of 2% and can cause major errors in integrated-out attitude and heading at high 
angular rates. 

The measurements are five in number: three derived field vector components and roll and pitch 
angle calculated from air data. These measurements are obtained by using the relations (21) 
and (25). 

As regards the measurement matrix Hj^, relation (21) is used to fill out the three top lines. This 
results in the three top lines of the matrix having the appearance 





Cl2^z 




^13^. 






0 0 0 


Cll 


c,2 


^13 








^23^^ 




C2xBy 


0 0 0 


^21 


^22 


^23 


f 33^> - 


^32^z 


^31^z- 


^33^x 






0 0 0 


^31 


^32 


^33_ 



(34) 



For the last two Unes of Hj^ Eqn (25) is used, by differentiadng the two right-hand parts with 
respect to edl states in the second Kalman filter 22. As a result, the last two lines get the 
elements (the index designates row and column in that order) 
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^41 = 1 - 



g^(cf , + C21 )" + ^'^(^33 • (0, + C32 • (Hy)^ 



K2 = 



2 



32 



T T 1 2 1 

g~ic\y+C2^) + V"(C33 • CO, + C 



32 • ^y) 



^32 <^33 



^43 = 



''45 



_ 2vg(CnC;2 + C21^22)('^33^; + ^32Q^y) ^^^7^31(^11 + <^lO ^31*^ 



/(cJi + C2j/ + V^(C33 • G)^ + C32 • CO^)^ 
V5C32(Cn +C21) 



33^ 

2 2 
C32 + c 



33 



^46 = - 



/(Cj, +C2,)^ + V-(C33 -O^ + C 
VgC33(cfi +C21) 



32 ■ %) 



g^(cf 1 + C2, f + V-(C33 ■ CO, + C32 ■ CO 



and 



/I5J = sin 



^52 = 



/153 = 



l^atan^^a- cosj^atan^Jp 



'32 



:^, + c?,V V C33; 033;^; 



(35) 



(36) 



The remaining elements in the fourth and fifth line are zero. 

The simplest choice for the covariance matrix for the measurement noise Rj^^ is a diagonal 
matrix. The first four measurement noise elements have a standard deviation which is set 
typically to one-tenth. The fifth measurement noise element on the other hand has a standard 
deviation that is set to a function of the altitude derivative and the speed. The function is quite 
simply a scaled sum of the expression for calculating pitch angle and according to Eqn (25) 
differentiated with respect to the altitude derivative and the speed. The function is set to 

(37) 

and gives a measure of the sensitivity of the pitch angle calculation to errors in the altitude 
derivative and the speed. 

Since the errors in attitude and heading calculated with the aid of the integration routine grow 
rapidly, estimated attitude and heading errors must be fed back to the integration routine. 



= 5 ■ 


^Qref 


+ 50- 


9e«f 




dh 
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which is done with wire 17. If this is not done, the error equations in the second Kalman filter 
22 rapidly become invalid by reason of the fact that the equations are fundamentally non- 
linear. In addition, the estimates of the zero errors in the angular rate gyros are fed back via a 
wire 18. This results in better linearisation of the second Kalman filter 22 and furthermore the 



In some flying situations the calculations that are performed in the second measurement 
routine 21 are inferior, either because the measurement equations are not sufficiently matched 
or because the measurement data is inherently poor. Calculation of the roll angle from air data 
is used only in level flight. No measurement is used if the angular rates are not sufficiently 
small, typically a couple of degrees or so per second. The measurement residuals are also 
checked, where the measurement residuals are not allowed to exceed typically one to two 
times the associated estimated uncertainty. 

Symbols 

Coordinate systems 

I (Inertial frame): a system fixed in inertial space. 

When flying above the surface of the earth it is customary for the centre of this system to 
coincide with the centre of the earth. This is really an approximation, since a system fixed in 
inertial space must not rotate. Because the earth rotates around the sun, the I-system will also 
rotate. However, the error that arises is negligible. The accelerations and angular rates 
measured by the sensors in an inertial navigation system are relative to that system. 
N (Navigation frame): a system with its centre in the aircraft and with its xy plane always 
parallel to the surface of the earth. 

The X-axis points to the north, the y-axis to the east and the z-axis vertically down towards the 
surface of the earth. 

B (Body frame): a system in the aircraft, fixed to the body frame. 

This coordinate system rotates with the aircraft. The x-axis points out through the nose, the y- 
axis through the starboard wing and the z-axis vertically down relative to the aircraft. 



sampling frequency can be kept down. 
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Table 1 Explanation of designations (symbols) for angles and angular rates. 
See also Figure 4. 







angle 9 along (roll angle). 






Tnitial valiip for thp roll anplp and p^tinnfltpH roll isnp^lp 
respectively 


<l>ref 




Roll angle calculated with the aid of data from air data 
and the heading derivative 


e 




Angle between and the horizontal plane (pitch angle). 


00' 0 




Initial value for the pitch angle and estimated pitch angle, 
respectively 


^ref 




Pitch angle calculated with the aid of data from air data 
and the slip sensors 


9 = 


[<t>,e]^ 


Compressed symbol for roll angle and pitch angle 


(p, (pQ, Aip 


Respectively: estimated roil and pitch angle, estimated 
initial values for roll and pitch angle and difference 
between integrated-out and reference-calculated roll and 
pitch angle 


9ref. <PaHRS 


Respectively: roll and pitch angle calculated with the aid 
of air data and primary data, and integrated-out roll and 
pitch angle, where integration is done with the aid of the 
angular rate gyro signals 






Respectively: angle between the projection of x^ in the 
horizontal plane and north (heading angle), and discrete 
indexing of heading angle 


a 




Angle between air-related rate vector projected on the z- 
axis in body frame and projected on the x-axis in body 
frame (angle of attack) 


P 




-rtjigie oetween air-reiaiea vciociiy vector dna djr-ici<iicu. 
velocity vector projected on the y-axis in body frame 
(sideslip angle) 






Transformation matrix (3x3 matrix) which transforms a 
vector from body frame (actual) to navigation frame. The 
elements of this matrix are designated c^, C£2» ^^3, C21, 
^22' ^23' ^31 » ^^32' ^33' where the index designates row and 
column in that order 




cf = cC' = 

B B 


Transformation matrix which transforms a vector from 
body frame (calculated) to navigation frame 
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Table 1 Explanation of designations (symbols) for angles and angular rates. 
See also Figure 4. 



8C^ 




Difference between calculated and true 




Yv' Yz) 


Rotation around, respectively, the x-, y- and z-axis in 
body frame » corresponding to the error between true and 
calculated body frame 


r 




Anti-symmetrical matrix form of the vector y 


CO;b = CO 




Angular rate around, respectively, the x-, y- and z-axis in 
body frame (angular rate gyro signals). These angular rate 
components are customarily also designated (/?, q, r)^ 






The vector co^^ expressed in anti-symmetrical matrix 
form 




Difference between actual and measured angular rate 
around, respectively, the x-, y- and z-axis in body frame 






Rotation of navigation frame relative to inertial frame that 
occurs when moving over the curved surface of the earth. 
An ti -symmetrical matrix form 


Table 2 


Explanation of symbols for the geomagnetic field. 


D E> r> 




Geomagnetic field vector components in body frame 






Difference between measured and actual field vector 
components in body frame 


^N'^B 




Geomagnetic field vector in navigation frame and body 
frame, respectively 


Table 3 


Explanation of symbols used in connection with filters 


ik, 1 




Used as an index, and represent the instant before 
and after time updating, respectively 


n, n + 1 




Used to represent the present and subsequent 
sample, respectively 


-, + 




Used as an index, and represent the instant before 
and after measurement updating, respectively 


X, z,P 




State vector, measurement vector and estimate 
uncertainty matrix 


w,Q 




Process noise vector and covariance matrix for 
process noise, respectively 
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Table 3 Explanation of symbols used in connection with filters 



A,F 


Prediction matrix in time-continuous and time- 




discrete form 


K, H, R 


Kalman gain matrix, measurement matrix and 




covariance matrix for measurement noise. 




respectively 




Driving noise for the Markov processes 


"^(0' '^b' '^s' '^y'^\>^2 


Time-constants 


fs 


Sampling frequency 



Table 4 Explanation of other symbols. See also Figure 5. 

b^, by, b^ Bias (zero errors) 

5^, s^, 5- Scale factor errors 

k^y, k^^, ky^, ky^, k^^^ k^y Cross-connection errors (for example, index xy stands 

for how the y -component affects the a: -component). 
Arise because the axes in triad are not truly orthogonal. 

h, h Altitude and low-pass-filtered time-derived altitude 

respectively 

v^, V True speed relative to the air 

g Gravity 
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CLAIMS 

1 . Method for synthetically calculating redundant attitude for an aircraft when the 
heading of the aircraft is known^ with the aid of data existing in the aircraft, such as the 
angular rates p, q, r around the x-, y- and z- coordinates of an aircraft-fixed (body frame) 
coordinate system, air data information in the form of speed, altitude and angle of attack as 
well as heading information, characterised in that the method includes the steps: 

- attitude is calculated on the basis of the aircraft-fixed angular rates p, q, r and 

- the calculated attitude is corrected by means of air data and heading. 

2. Method according to claim 1, characterised in that the heading information is 
obtained from a heading gyro. 

3. Method according to claim 1 or 2, characterised in that attitude is integrated out via 
information about the body-frame angular rates (p, q and r) obtained from the aircraft-fixed 
angular rate gyros of the aircraft. 

4. Method according to claim 3, characterised in that correction of the integrated-out 
attitude takes place with the aid of attitude calculated on the basis of air data information and 
heading information. 

5. Method for synthetically calculating redundant attitude and redundant heading for an 
aircraft with the aid of data existing in the aircraft, such as the angular rates p, q, r around the 
X-, y- and z- coordinates of an aircraft-fixed (body frame) coordinate system, air data 
information in the form of speed, altitude and angle of attack, characterised in that the 
method includes the steps: 

- attitude and heading are calculated on the basis of the body-frame angular rates p, q, r 

- the errors in the measured body-frame magnetic field vector components are estimated, 

- the measured body-frame field magnetic field vector is derived, 

- errors in calculated attitude and heading are estimated with the aid of air data and derived 
measured body-frame magnetic field vector components and 

- the calculated attitude and heading are corrected by means of estimated errors in attitude and 
heading. 
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6. Method according to claim 5, characterised in that attitude andr heading are 
integrated out via information about the aircraft's body-frame angular rates (p, q and r) 
obtained from the aircraft's body-frame angular rate gyros. 

7. Method according to claim 5, characterised in that estimation of errors in measured 
body-frame magnetic field vector components is performed in a first filter (11). 

8. Method according to claims 6 or 7, characterised in that in a second filter (22) is 
performed estimation of attitude errors and heading errors that arise on integration of the 
aircraft's body-frame angular rates (p, q and r) obtained from the aircraft's body- frame angular 
rate gyros, where the estimation is done with the aid of attitude calculated from air data 
information as well as derived measured body-frame magnetic field vector components. 

9. Method according to claims 7 or 8, characterised in that the filtering takes place 
with the aid of Kalman filters. 

10. Arrangement for synthetically calculating redundant attitude for an aircraft when the 
aircraft's heading is known, with the aid of data existing in the aircraft such as the aircraft's 
body-frame angular rates (p, q and r), air data including at least speed, altitude and angle of 
attack as well as heading information, characterised in that the arrangement includes an 
integration routine (8) to integrate out the aircraft's attitude from information about the 
aircraft's body-frame angular rates (p, q and r) as well as that the calculated attitude is 
corrected by means of reference attitude from air data and redundant heading. 

1 1 . Arrangement according to claim 10, characterised in that the heading information is 
obtained from a heading gyro. 

12. Arrangement according to claim 10 or 11, characterised in that integration routine 
(8) integrates out the aircraft's attitude from the aircraft's body-frame angular rates (p, q and r) 
obtained from the aircraft's body-frame angular rate gyros. 

13. Arrangement according to claim 12, characterised in that the integration routine (8) 
is fed with the zero-error-compensated body-frame angular rate gyro signals. 
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14. Arrangement according to claim 10, characterised in that a reference attitude is 
calculated with air data information as well as redundant heading information. 

15. Arrangement according to claim 10, characterised in that a synthetically-generated 
corrected attitude is obtained by generating a difference between the attitude obtained from the 
integration routine (8) and an error signal that represents the error between the integrated 
attitude and the reference attitude. 

16. Arrangement for synthetically calculating redundant attitude and redundant heading 
for an aircraft with the aid of data existing in the aircraft such as measured body-frame field 
vector components, the aircraft's body-frame angular rates (p, q and r) as well as air data 
including at least speed, altitude and angle of attack, characterised in that the arrangement 
includes a first measurement routine (10) which transforms the measured body-frame 
magnetic field vector components to the aircraft's navigation system (navigation frame), a fu*st 
filter (11) which estimates the errors in the calculated measured body-frame field vector 
components, an integration routine (20) for integrating out the aircraft's attitude and heading 
from information about the aircraft's body-frame angular rates (p, q and r), a second filter (22) 
for estimating the errors arising in attitude and heading obtained in the said integration and a 
second measurement routine (21) for calculating attitude and heading from air data and 
derived measured body-frame magnetic field vector components. 

17. Arrangement according to claim 16, characterised in that the first measurement 
routine (10) is fed with the measured body-frame magnetic field vector components, as well as 
attitude and heading from the aircraft's normal navigation system and transforms the measured 
body- frame magnetic field vector components to the aircraft's navigation frame. 

18. Arrangement according to claim 17, characterised in that the fu-st filter (11) is fed 
with information from the first measurement routine (10) and estimates the errors in the 
measured body-frame magnetic field vector components. 
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19. Arrangement according to claim 16, characterised in that the integration routine 
(20) integrates out the aircraft's attitude and heading from the aircraft's body-frame angular 
rates (p, q and r) obtained from the aircraft's body-frame angular rate gyros. 

20. Arrangement according to claim 16, characterised in that the second measurement 
routine (21) is fed with air data, the derived measured body-frame magnetic field vector 
components and with information about the aircraft's body-frame angular rates (p, q and r) and 
from these values calculates an attitude and a heading. 

21. Arrangement according to claim 20, characterised in that the second filter (22) is 
fed with information from the second measurement routine (21) and estimates the errors in 
attitude and heading as well as zero error in body-frame angular rate gyro signals and residual 
errors in the measured body-frame magnetic field vector components for generating an error 
signal. 

22. Arrangement according to claim 21, characterised in that a synthetically-generated 
corrected attitude and heading are obtained by generating a difference between 

- the attitude obtained from the integration routine (20) and heading and 

- the error signal from the second filter (22). 

23. Arrangement according to claim 19, characterised in that the integration routine 
(20) is fed with body-frame angular rate gyro signals compensated for estimated zero errors. 

24. Arrangement according to any of claims 16 - 23, characterised in that the first filter 
(11) and/or the second filter (22) consists of a Kalman filter. 
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